BLUE_PRINT_LIB = {
    "vehicle.audi.a2": {
        "location": [
            1.1874361216523965e-10,
            0.00033203110797330737,
            0.7818066477775574
        ],
        "extent": [
            1.852684736251831,
            0.8943392634391785,
            0.7745251059532166
        ],
        "num_wheel": 4
    },
    "vehicle.audi.tt": {
        "location": [
            -0.00037109359982423484,
            1.3271345133958334e-10,
            0.6926488876342773
        ],
        "extent": [
            2.0906050205230713,
            0.9970585703849792,
            0.6926480531692505
        ],
        "num_wheel": 4
    },
    "vehicle.micro.microlino": {
        "location": [
            -2.0954755292068583e-11,
            -5.8593730500433594e-05,
            0.6771557331085205
        ],
        "extent": [
            1.1036475896835327,
            0.7404598593711853,
            0.6880123615264893
        ],
        "num_wheel": 4
    },
    "vehicle.bmw.grandtourer": {
        "location": [
            -1.885927941591703e-10,
            -0.0005273435963317752,
            0.7651049494743347
        ],
        "extent": [
            2.3055028915405273,
            1.1208566427230835,
            0.8336379528045654
        ],
        "num_wheel": 4
    },
    "vehicle.mercedes.sprinter": {
        "location": [
            -0.010537102818489075,
            0.004140627570450306,
            1.2882421016693115
        ],
        "extent": [
            2.957595109939575,
            0.9942164421081543,
            1.2803276777267456
        ],
        "num_wheel": 4
    },
    "vehicle.dodge.charger_police": {
        "location": [
            0.023632802069187164,
            0.0006054601399227977,
            0.7926709055900574
        ],
        "extent": [
            2.487122058868408,
            1.0192005634307861,
            0.7710590958595276
        ],
        "num_wheel": 4
    },
    "vehicle.jeep.wrangler_rubicon": {
        "location": [
            0.00021484403987415135,
            0.00103515584487468,
            0.9322753548622131
        ],
        "extent": [
            1.9331103563308716,
            0.9525982737541199,
            0.9389679431915283
        ],
        "num_wheel": 4
    },
    "vehicle.mini.cooper_s": {
        "location": [
            -2.0954755292068583e-11,
            -5.8593730500433594e-05,
            0.6930102109909058
        ],
        "extent": [
            1.9029000997543335,
            0.985137939453125,
            0.7375151515007019
        ],
        "num_wheel": 4
    },
    "vehicle.nissan.micra": {
        "location": [
            3.492459099696532e-10,
            0.0009765622089616954,
            0.7812451124191284
        ],
        "extent": [
            1.8166879415512085,
            0.9225568771362305,
            0.7506412863731384
        ],
        "num_wheel": 4
    },
    "vehicle.carlamotors.carlacola": {
        "location": [
            0.0,
            0.0,
            1.2337206602096558
        ],
        "extent": [
            2.601919174194336,
            1.3134948015213013,
            1.2337223291397095
        ],
        "num_wheel": 4
    },
    "vehicle.mercedes.coupe_2020": {
        "location": [
            -0.00259765493683517,
            9.289941038659322e-10,
            0.7203612923622131
        ],
        "extent": [
            2.3368194103240967,
            1.0011461973190308,
            0.7209736704826355
        ],
        "num_wheel": 4
    },
    "vehicle.dodge.charger_police_2020": {
        "location": [
            0.109501913189888,
            -3.916094470923781e-08,
            0.8174071907997131
        ],
        "extent": [
            2.6187572479248047,
            1.0485419034957886,
            0.819191575050354
        ],
        "num_wheel": 4
    },
    "vehicle.mini.cooper_s_2021": {
        "location": [
            -0.031249990686774254,
            1.1175869119028903e-08,
            0.8910351395606995
        ],
        "extent": [
            2.2763495445251465,
            1.0485360622406006,
            0.8835831880569458
        ],
        "num_wheel": 4
    },
    "vehicle.bh.crossbike": {
        "location": [
            0.00029444904066622257,
            195.28602600097656,
            0.5411913990974426
        ],
        "extent": [
            0.7436444163322449,
            0.0,
            0.5397894978523254
        ],
        "num_wheel": 2
    },
    "vehicle.nissan.patrol": {
        "location": [
            -0.05737302824854851,
            0.00015627048560418189,
            0.9351245164871216
        ],
        "extent": [
            2.3022549152374268,
            0.9657964706420898,
            0.9274230599403381
        ],
        "num_wheel": 4
    },
    "vehicle.kawasaki.ninja": {
        "location": [
            -0.01960790529847145,
            195.23898315429688,
            0.5854394435882568
        ],
        "extent": [
            1.0166761875152588,
            0.0,
            0.5727267861366272
        ],
        "num_wheel": 2
    },
    "vehicle.lincoln.mkz_2020": {
        "location": [
            -0.006289059761911631,
            2.249143760124639e-09,
            0.7437793016433716
        ],
        "extent": [
            2.44619083404541,
            1.115301489830017,
            0.7400735020637512
        ],
        "num_wheel": 4
    },
    "vehicle.lincoln.mkz_2017": {
        "location": [
            0.004042967688292265,
            -1.4458780839277097e-09,
            0.718859851360321
        ],
        "extent": [
            2.4508416652679443,
            1.0641621351242065,
            0.7553732395172119
        ],
        "num_wheel": 4
    },
    "vehicle.ford.mustang": {
        "location": [
            0.03213866055011749,
            -1.149368333841494e-08,
            0.6504687070846558
        ],
        "extent": [
            2.358762502670288,
            0.947413444519043,
            0.650469958782196
        ],
        "num_wheel": 4
    },
    "vehicle.tesla.cybertruck": {
        "location": [
            0.0,
            0.0,
            1.049096703529358
        ],
        "extent": [
            3.1367764472961426,
            1.1947870254516602,
            1.049095630645752
        ],
        "num_wheel": 4
    },
    "vehicle.ford.ambulance": {
        "location": [
            -0.2885546088218689,
            0.001933696330524981,
            1.2156102657318115
        ],
        "extent": [
            3.18282151222229,
            1.1755871772766113,
            1.215687870979309
        ],
        "num_wheel": 4
    },
    "vehicle.mercedes.coupe": {
        "location": [
            -2.7939672797572257e-10,
            -0.0007812496623955667,
            0.6667944192886353
        ],
        "extent": [
            2.5133883953094482,
            1.0757731199264526,
            0.8253258466720581
        ],
        "num_wheel": 4
    },
    "vehicle.seat.leon": {
        "location": [
            -0.00014648489013779908,
            -0.0015624993247911334,
            0.7396337985992432
        ],
        "extent": [
            2.0964150428771973,
            0.9080929160118103,
            0.7369155883789062
        ],
        "num_wheel": 4
    },
    "vehicle.nissan.patrol_2021": {
        "location": [
            0.028378896415233612,
            -1.0149086016042475e-08,
            1.0167187452316284
        ],
        "extent": [
            2.782914400100708,
            1.0749834775924683,
            1.0225735902786255
        ],
        "num_wheel": 4
    },
    "vehicle.vespa.zx125": {
        "location": [
            0.010460472665727139,
            195.32354736328125,
            0.6211523413658142
        ],
        "extent": [
            0.9023334980010986,
            0.0,
            0.6178141832351685
        ],
        "num_wheel": 2
    },
    "vehicle.yamaha.yzf": {
        "location": [
            -0.004266120493412018,
            195.2182159423828,
            0.64984130859375
        ],
        "extent": [
            1.1047229766845703,
            0.0,
            0.6255727410316467
        ],
        "num_wheel": 2
    },
    "vehicle.chevrolet.impala": {
        "location": [
            5.859437442268245e-05,
            0.0017968743341043591,
            0.70149165391922
        ],
        "extent": [
            2.6787397861480713,
            1.0166014432907104,
            0.7053293585777283
        ],
        "num_wheel": 4
    },
    "vehicle.volkswagen.t2": {
        "location": [
            0.0013281241990625858,
            -0.0005468753515742719,
            1.0144726037979126
        ],
        "extent": [
            2.2402184009552,
            1.034657597541809,
            1.0188959836959839
        ],
        "num_wheel": 4
    },
    "vehicle.citroen.c3": {
        "location": [
            8.451751520865969e-10,
            0.002363280626013875,
            0.76191645860672
        ],
        "extent": [
            1.9938424825668335,
            0.9254241585731506,
            0.8085547685623169
        ],
        "num_wheel": 4
    },
    "vehicle.diamondback.century": {
        "location": [
            1.1252891454205383e-05,
            195.3052520751953,
            0.525390625
        ],
        "extent": [
            0.8214218020439148,
            0.0,
            0.5119513869285583
        ],
        "num_wheel": 2
    },
    "vehicle.tesla.model3": {
        "location": [
            0.02921873889863491,
            -1.0449437759518787e-08,
            0.7355297803878784
        ],
        "extent": [
            2.3958897590637207,
            1.081725001335144,
            0.744159996509552
        ],
        "num_wheel": 4
    },
    "vehicle.carlamotors.firetruck": {
        "location": [
            -0.25343742966651917,
            0.005312588065862656,
            1.9133495092391968
        ],
        "extent": [
            4.234020709991455,
            1.4455441236495972,
            1.9137061834335327
        ],
        "num_wheel": 4
    },
    "vehicle.audi.etron": {
        "location": [
            0.0,
            0.0,
            0.8205029368400574
        ],
        "extent": [
            2.427854299545288,
            1.0163782835006714,
            0.8246796727180481
        ],
        "num_wheel": 4
    },
    "vehicle.dodge.charger_2020": {
        "location": [
            -0.006230466067790985,
            2.228188966668654e-09,
            0.76557856798172
        ],
        "extent": [
            2.5030298233032227,
            1.0485419034957886,
            0.7673624753952026
        ],
        "num_wheel": 4
    },
    "vehicle.gazelle.omafiets": {
        "location": [
            -0.01564301736652851,
            195.3675537109375,
            0.5801635384559631
        ],
        "extent": [
            0.9177202582359314,
            0.0,
            0.5628286004066467
        ],
        "num_wheel": 2
    },
    "vehicle.harley-davidson.low_rider": {
        "location": [
            -0.008875441737473011,
            195.3657989501953,
            0.6599145531654358
        ],
        "extent": [
            1.1778701543807983,
            0.0,
            0.6382853388786316
        ],
        "num_wheel": 2
    },
    "vehicle.toyota.prius": {
        "location": [
            0.001992186764255166,
            -0.00039062555879354477,
            0.724169909954071
        ],
        "extent": [
            2.256761312484741,
            1.0034072399139404,
            0.7624167203903198
        ],
        "num_wheel": 4
    }
}

TOWN_DICTIONARY = {
    '2021_08_20_21_48_35': 'Town06',
    '2021_08_18_19_48_05': 'Town06',
    '2021_08_20_21_10_24': 'Town06',
    '2021_08_21_09_28_12': 'Town06',
    '2021_08_22_07_52_02': 'Town05',
    '2021_08_22_09_08_29': 'Town05',
    '2021_08_22_21_41_24': 'Town05',
    '2021_08_23_12_58_19': 'Town05',
    '2021_08_23_15_19_19': 'Town04',
    '2021_08_23_16_06_26': 'Town04',
    '2021_08_23_17_22_47': 'Town04',
    '2021_08_23_21_07_10': 'Town10HD',
    '2021_08_23_21_47_19': 'Town10HD',
    '2021_08_24_07_45_41': 'Town10HD',
    '2021_08_24_11_37_54': 'Town07',
    '2021_08_24_20_09_18': 'Town04',
    '2021_08_24_20_49_54': 'Town04',
    '2021_08_24_21_29_28': 'Town04',
    '2021_08_16_22_26_54': 'Town06',
    '2021_08_18_09_02_56': 'Town06',
    '2021_08_18_18_33_56': 'Town06',
    '2021_08_18_21_38_28': 'Town06',
    '2021_08_18_22_16_12': 'Town06',
    '2021_08_18_23_23_19': 'Town06',
    '2021_08_19_15_07_39': 'Town06',
    '2021_08_20_16_20_46': 'Town06',
    '2021_08_20_20_39_00': 'Town06',
    '2021_08_20_21_00_19': 'Town06',
    '2021_08_21_09_09_41': 'Town06',
    '2021_08_21_15_41_04': 'Town05',
    '2021_08_21_16_08_42': 'Town05',
    '2021_08_21_17_00_32': 'Town05',
    '2021_08_21_21_35_56': 'Town05',
    '2021_08_21_22_21_37': 'Town05',
    '2021_08_22_06_43_37': 'Town05',
    '2021_08_22_07_24_12': 'Town05',
    '2021_08_22_08_39_02': 'Town05',
    '2021_08_22_09_43_53': 'Town05',
    '2021_08_22_10_10_40': 'Town05',
    '2021_08_22_10_46_58': 'Town06',
    '2021_08_22_11_29_38': 'Town06',
    '2021_08_22_22_30_58': 'Town05',
    '2021_08_23_10_47_16': 'Town04',
    '2021_08_23_11_06_41': 'Town05',
    '2021_08_23_11_22_46': 'Town04',
    '2021_08_23_12_13_48': 'Town05',
    '2021_08_23_13_10_47': 'Town05',
    '2021_08_23_16_42_39': 'Town04',
    '2021_08_23_17_07_55': 'Town04',
    '2021_08_23_19_27_57': 'Town10HD',
    '2021_08_23_20_47_11': 'Town10HD',
    '2021_08_23_22_31_01': 'Town10HD',
    '2021_08_23_23_08_17': 'Town10HD',
    '2021_08_24_09_25_42': 'Town07',
    '2021_08_24_09_58_32': 'Town07',
    '2021_08_24_12_19_30': 'Town07',
    '2021_09_09_13_20_58': 'Town03',
    '2021_09_09_19_27_35': 'Town01',
    '2021_09_10_12_07_11': 'Town04',
    '2021_09_09_23_21_21': 'Town03',
    '2021_08_21_17_30_41': 'Town05',
    '2021_08_22_13_37_16': 'Town06',
    '2021_08_22_22_01_17': 'Town05',
    '2021_08_23_10_51_24': 'Town05',
    '2021_08_23_13_17_21': 'Town05',
    '2021_08_23_19_42_07': 'Town10HD',
    '2021_09_09_22_21_11': 'Town02',
    '2021_09_11_00_33_16': 'Town10HD',
    '2021_08_18_19_11_02': 'Town06'
}


class bcolors:
    HEADER = '\033[95m'
    OKBLUE = '\033[94m'
    OKCYAN = '\033[96m'
    OKGREEN = '\033[92m'
    WARNING = '\033[93m'
    FAIL = '\033[91m'
    ENDC = '\033[0m'
    BOLD = '\033[1m'
    UNDERLINE = '\033[4m'


EXCLUDE_ROAD_MAP = ['2021_08_18_19_11_02',
                    '2021_08_21_09_09_41',
                    '2021_08_23_16_42_39',
                    '2021_08_23_17_07_55',
                    '2021_08_24_12_19_30',
                    '2021_08_24_09_25_42',
                    '2021_08_24_09_58_32',
                    '2021_08_24_12_19_30',
                    '2021_08_21_09_28_12',
                    '2021_08_24_11_37_54',
                    '2021_08_23_17_22_47',
                    '2021_08_24_20_09_18']

OR_Z_VALUE_MAP = ['2021_08_22_09_43_53',
                  '2021_08_22_10_10_40',
                  '2021_08_23_12_13_48',
                  '2021_08_23_13_10_47',
                  '2021_08_24_09_25_42',
                  '2021_08_24_09_58_32',
                  '2021_08_24_12_19_30',
                  '2021_09_09_23_21_21',
                  '2021_09_10_12_07_11',
                  '2021_08_22_09_08_29',
                  '2021_08_23_12_58_19',
                  '2021_08_23_17_22_47',
                  '2021_08_24_11_37_54',
                  '2021_08_24_20_09_18']
